#include <iostream>
#include <opencv2/opencv.hpp>
#include "camera.h"

using namespace std;
using namespace cv;

int main(int argc, char **argv) {
    
    cv::Size imagesize;
    imagesize.width=1080;
    imagesize.height=720;
    
    float cf=10;
    float calph=1;
    float cdistor[5]={0, 0, 0, 0, 0};
    float cpost[9]={1,0,0,0,1,0,0,0,1};
    float cpos[3]={39,100,41};
    camera camera1(cf, calph, imagesize, cdistor, cpos, cpost);

    Point3f pos;
    pos.x=50;
    pos.y=52;
    pos.z=10;    
    cout<<camera1.project(pos)<<endl;;

    return 0;
}
